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(54) SERVO CONTROLLER AND SERVO CONTROLLING METHOD 

(57)Abstract 

PROBLEM TO BE SOLVED: To provide a servo controller and method for 
accurately and quickly estimating disturbance, and for accurately realizing 
servo control even at the time of suppressing disturbance and feedback 
controlling an object to be controlled by inexpensively and easily constituting 
servo control system by using an observer whose constitution is simple. 
SOLUTION: This servo controller is provided with an observer 5b for 
estimating disturbance to be impressed from the outside part to an object to 
be controlled in a spring system such as a focus actuator, and for generating 
disturbance estimate, and the disturbance is compensated based on the 
disturbance estimate, and the object to be controlled is feedback controlled i 
this servo controller. The observer 5b estimates the disturbance by using an 
inner model in an inertial system defined by a characteristic equation includir 
only a second-order term as an inner model indicating the object to be 
controlled in at least a frequency band with the specific oscillation frequenci« 
of the object to be controlled or more. 
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^XHKSKBtfJ-ra. c©£*. S»T^a^8iJSS 

»5«. 5y7^s»f (s) jcs-5<-e©{a«sttK: 

[007 61-eur. K^-rxiasssB. «E©^ra> 
wms* w-r s mm^ s i < c ©nibfi-st s i a«r 

iXa»^«l0tcteWSSESijm«Ei ift-5. ) 
u>Xt»»S**t*«:. 1 -vgHfcS9'Mti#r 

^ . »mi-*t s uic *> w h mzmnicttfot zwm* 

Si©«fc«) MmtZ-fu •> JttHfcfeWS K 9<f 
XEISgl 8©93fcSS£Kdr (Ampere/Volt) tUi>. 
(007 7 1 HK. I -V^fegQB. igfflrti-tSi© 
WiftffifctSEffiKXft 0 . ±fflSIlMKEfS*l S iv£ L-T 
7^py?i#gSf5^Hi*T*c C©£*. MiSEl-V 
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tSXo 9 £«Blc45tt& I - VgSftS9©£gy8KK 
iv (Volt / Ampere) iftS. 
[007 8 ] ±&h1dtkl9&M?h f » *7 ? 7' 

[ 0 0 7 9 ] ft fe\ 05 tttf If — '^T^TrtSPXP » 

10 ©^#*^-r^0 7d'ISlH-c*S. */c S5(cfcc^ 
StUtSPSSR i B-©S0ai£3R«: oi»r «. ra-©«^* 
[ o o 8 o ] ft-r\ * i i»Ktii>ttt, iNfip^ft 

U (s) «79^»x-*l a-C*5©T. WSPlyB 
^g[7d/?*x-^ 1 aCCtO^Si^nS^U^X© 
tSIKieiCTicSilft^lS]©(4§i ft^>. 
[008 1 ] ^..^79?ii-f 1 a©e»M»B 
JJB^C ( 8 ) ©<fc ^ tc 2 i LrififHr^ 
20 [008 2] JJ27*-*^i5-ttWS2tcte 

g^±a>L/cJ: 9 tCKe (Volt/m) iTSi. 
[008 3] 

CSJtl 3] ref-yxKe=er - (10) 
tftS. CCt, er!*±ji0fc«t9tC»fg^-C*0re 
ft*BSII-C*4. ±K ( 1 0) aSCCfcOWfc 

n/c»ffl^er«. *Xlf-^5 b©-^©A**f-«: 

[0084] fla*. SMu tm$))MWL i ©M»B. F 
30 V 4 XEIK 8 CCtel-t h ^E^ffig&SK£ K dr ( Ampere 
/Volt) iT&£. 
[0085] 

[»1 4] i =KdrX U - (11) 
ift-2>. •tit, COSBftWSiB. «fE/«EEgE8M» 
K*Kiv (Volt/Ampere) T'&S I -V^SS9«C«fc->r 

Xlf-^5b©ft^©A*4SIS^^W33ft*. 1"ft*5 

[0086] 
40 [ftkl 5] v = KivX i - (12) 

CCT. 3ft 1 HiHBB©*Xir- ■><©£(*« 4 I'^B. 

©HO©S^gi. H-o©toS^lii. tcfc^m^n 

^Evi&A^iT'&CitC.tO W-SL«:ltS b . ±BB»ffi 
S u (CDD^-r 6 C t K J: ») SttKftt u ^rffllET Sfc* 
©WiiESh^JiS-rS. 

[0 08 7 ] .kORftWtcB. itef. A**Ev(cWO 
50 T^k45rSD^fc©^P>. »2a»S*>6W*3n 
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e«ett«vn«:«ftk3*«Cfc<>©t«W«ler4* * < s ) ) Ktoai*&ttSlcHs^tofcofc±«se*-*i, 

i masicAas ft*. i o o 9 2 1 

[0 08 8)^(C. »l«»SCE>a»*>6. *2«»S [|U 6] y= (i +disa) xu (s> - (13) 
^6ttl*Sti4lftjeffilKyn{c«»k3*3lli;A:fc©ilM tttft. 

jaHB^eri**D#Ufcfe©tt:ffftk24ftCtefe©A*« [ 0 0 9 3 ] 5Wc. &^S***fc*l*tt«:#«C 1 / 

*sti. ^(omm^m 2 «agtc a* § n s . stu H5tc>i^»2«fl»©atfj*7***x-$r 

[ 0 0 8 9 ] * L-C »2«»S©ai^C*4Ji!BaBE 1 aCHSftgvn (COi*. Sl^iS{4gvn^K:±gS 
{4gyM^k3^0fcfe©*s±IB$UiHiMer<»:©»n ftfiMP»disa**«*VCl»*«: i&ftS. ) tt/t. 

twcmati*. 10 *fc?>i©*^-'<5b©«w*^*afc©©.tia& 

[0090] ijaitsetitiBvntcftftk 3*ssc &$kij?>£k 5©{Sft-oi>-t&§f-r5„ _ 

fct©t*«mBaert©ttllttS*CC«Mftk5*JP*L/c [0094] ^. 05©^, 

fi-ctozniEMh t L-cmmmvmmmtmns i o o 9 5 ] 

(0 09 1 ]iWt. 7>fai-fla (W»»*U * 

(er+ynxk3) x k 5= h - ( 1 4) 

[ {KivX i Xk4- (er+vnXk3) Xkl) X (1/s) - (er+ynXk3) 
xk2] x (1/s) =yn - (1 5) 

cc-c, ±ie^ (i i) Vtff (i 3) <k<5, 2o^«A-r*4. 

[0096] [0099] 

[ft! 8] [$21] [ {KivX i xk4- (-y xKe+h/k5+ 

y= (Kdrxu + disa) xu (s) - (13a) y x Ke) x kl] x ( 1 / s ) - (- y x Ke + h/k 

IK, StMiref* r 0 j ±SK(10) =fc 5+yxKe) xk2] x (1/s) = (h/k5+yx 

15 Ke)/k3 

-yXKe=er - (10a) ±K©lBUa* s ««LT«E«r44. 

C©K£J:f55£ (14) (CftA* . [0100] 

[0 09 7] [$2 2] KivX i xk4- (h/k 5) xkl- (h/k 

[$19] (-yXKe+ynXk3) xk5=h 5) x k2X s = (h/k 5+ y x Ke) x s l /k 3 

coxzmtox. 30 c©s:i±id^ (in i *ffi*Lsai^& 

[0098] 

[1520] vnx k3= h/k5+y xKe - (14a) [0101] 
C©^i±ie^ ( 1 0 a ) £ftiC:£ ( 1 5 ) [$2 3] 

Kivxk4x Kdrx u = (h/k5+yxKe) x s '/k3+ (h/k5) xr 2 x 
s+ (h/k5) Xkl - (15a) 

cct-. mcmmimc (s) ©ji-^*7iu * to 103] 

'«Eah©#t»(,»rWa««sat»Er [$25]u=e+h - (17) 
(Mffl«»»C(s)©Htt}e*»tr&i. c©5£(17) £9. e = 0©££«u= h£ft£© 

[0102] t. ±E5«(15a)4l/uft«i. 

[$24] e = erXC (s) - (16) 40 [ 0 1 0 4 ] 

V3bZ>0)-C. * [$2 6] 

KivXk4X Kdr= (l/(k3Xk5) + (Ke/k3) xy/u] x s ' + 
(k2/k5) x s + (Kl/k5) - (15 b) 

C©^i±l2^ (13a) KJ:»)y4iB4b-CSE»rft * (0 1 0 5] 
i A [$27] 

KivXk4X Kdr= sV (k3Xk5) + (Ke/k3) XKdr+disa/u) X 

U (s) x s '+ (k2/k5) x s + (kl/k5) 
Kdr x (Kivxk4-U (s) x s J xKe/k3) - (Ke/k3) x (disa/u 
) xU (s) x s'= (sVk3+k2X s +kl) /k5 - (15 c) 
CCt 3t ( 1 5 c ) OMEatCfcHT. «»»*U 50 ( s ) StST*^-^ brt©«W*^HJn ( s ) 
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*/<*-7^3R*fe«tt»«:SaEl/"C»fi«^*i. *tu (s) 

[0106] t° 107] 
UR2 8] Un (s) =Ax wa , /s' ••• (9a) [«2 9] 

tb. « ( 1 5 c) tC*$t»"CU (s) ^Un (s) <!: b * 

Kdr x (KivXk4-AXwa'xKe/k3) - (Ke/k3) x (disa/u) xa 
x wa '= (s ! /k3+k2Xs + kl) /k5 ••• ( 1 5 d ) 
K1C a(15d)«lfJCfcW. .. » Hk32] -(Ke/k3) x (disa/u) x A x„a = 

[0108] (s'/k3+k2X S +kl) /k5 

[$3 0] * ?>iUC ' 

KivXk4-AXwa'xKe/k3=0 - (18) 10 [ 0 1 1 1 ] 

kI=l/Kiv ••• (19) [^33] -u/disa= (k5XKeXAX W aVk3)/ 

(s'/k3+k2X s + kl) 

[0 i09] Cffl3C4JllB«(2 0) iO. 

[gl31] k3=AXya'XKe- (20) [0112] 

6**), ±835$ (1 5d) t* [»3 4] 

[0110] * /<% ^ 

-u/disa=k5/ (sVk3+k2Xs+kl) - (2 1) 

tUh CCT C©£ (2 1) tt. ttfiSK^ftdisafr *#J8itt-fttf 

6 WttB (it»r*i. e -OtUfcA'«©WE« CO 1 16] *«©**irw<5 bK* 

»»B4i2*©0-^^>«tt-e**Ci*« K*9. ±ia*(22a) **±fc**S**C±tt* 
[0113] ±E5JC ( 1 3 a) ,1:0. MHy [0 1 1 7 ] *CC. ±ES <2 1 > KfiWftttwT 

[®35]KdrX U+ disa=0 - (22) ft. > *|*vc^lU« (2 2 a> 
*SfiJtiW*tf*J:<. *©J*£KW:J^!S0fa<lisatt3E± , . 

WKE8*i*Cifc**. WBWttL«Hsrt [0118]*. S«u>i*h7,**R < » ) ©fc* 

^icWH-T § fc«xc«. ±lfi£ (2 2) J: 9. fttt*. 

[0115] 30 [0119] 

[R3B] -u/disa= 1/Kd r - (22a) * [«3 7] 

R (s) =wr ! /(S' + 2xkrXwr+wr ! ) - (2 3) 

tth. C©£*. krttCUtXh 7 < *1«38J 

y 7T ^T*») wrtt*©*»h*?J9««(rad - u/disa= ( 1 /Kdr) X R ( s ) - (22b) 

/sec)T?*S. CftKA"). n^h^J^^ ttt*. C©^(22b) 4«(2 1)*6. 

T±1£K (2 2a) [012 1] 

[0120] * ^ 39 > . . 

k5Xk3/ ( s J + k2Xk3X S + klXk3) = (1/Kdr) XR (s) 

- (24) 

±B*<2 3) 45S(24) J:0. 1 8> * <26> »3E <27> 

[0122] ©k3*ifiiT44. 
[844 0] kixk3=wr j - (25) [0123] 
k2Xk3=2xkr xwr - (26) [$44 1] 

k3Xk5= 1/Kdr - (27) O 

kl=w rV (AXwa'xKe) - (2 8) 

k2=2 xk r xwr/ (AXwa'xKe) - (29) 

k5= 1/ (KdrXAXwa'xKe) - (30) 

c**r©*H«fc**fc. MWH*u (.) ^^^^^I'™ llf** 
S2^«R*6««lcaWU rXO^ 50 (29). (19). (2 0)^(30)^5 
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tmt?2tf,c£K). wc*©H*ffiawaaaRwaj:») 
i&v®®mm nx. n» &*dfc <* -* 1 * *©w»*t 

[0 1 24] *UC. Cfl>fKt*^1f-'<6 b^&£A 

s n/cffliEs h *ttf« u unm lx nmnrn ^ s u 

*&tfU CttCCfcD F5 4:/ll?88£IM&l/t±ffilK 
fifths 1££6SU 7?f-*x-* 1 attttiTJbCti 
C 4 £ ft*. 

[ 0 1 2 5 ] C HOC <fc •) . 5I#©7 w - FX ~> i?mW® 

[0126]^, Jita{4tBffi«?IC ( s ) ©JMtWi 
l/ttt. «*.«. *©WWM»tlx-Cl»te**P 1 DM 

[0 127] 

[R42] C (s) =Kp+Ki/s + KdX s 
£&5. CCt, Kpttlfc«WC*»>, KlttWMtr* 
9. KdttflkftqiTNbS. £©££. 7^^i-f 1 

tiffllS5 a{c«t«) *-*IMWbff«:lCTW)«l»aflE* X 

[0128] JglJJMPi 1/fe J: S «C . Ill 1 JtfflBftO* rf 

©rtSI5*f\»l£ffll>rflDjfg^disa£}g£T5©r. 
fS^&flMS©*?*-?--'^ b£flH.>£*B£fc. —^©JR 

[0 129] Sfc. ia©B-^X7 -f^MSteSrWf 
&cm'* F 7 •< ;U^5:ffi(,>TAPiilSHSLdisa=S:^-r5 
©T\ 7 * - F >< v fWffllJftKfc^-CSISrtW*^© 

[0130] JEK. *-*^-9--«WWW© 
fc&©7*^x-£ laT*5©t. K-B-a^ffi^ 

[0131] IK*fe. 5 b £ 1/ 

w**i-xati3fi-c*4c4tceH-r*»^«©fiera% 

HjBf*ct3&«-C*. a»»«-8©ffa»cit8Bt**^ 
b^©A^J(I-^©iSS/'N (Signal /Noise) tt 

s^ia is ©»©«*»> ^©^^©was+^tfit 
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iSr t»a<fcK:» i/r**jft J: ? tc«teR*BHMtr* s 

[0132] fcfe. _b$©l& 1 ««MI©*l< ><*va 

*©ftfl»s«kicEiijia**i*"5iffitt©**wst*flitt*© 

»j£{c«J:ft«. B3 (a) «c*TJ:5«:. 7??ai- 

[0 13 3] SE/c. JJI©» 1 JOBHBKfclvctt. f 

c titWfc . SRWft u > * F 7 » * > y 

(ftftffJKl*. DPD (Differential Phas 
e Detection) &*>3 fcr-Affi**flH»fc F 5 v^sif 

20 <Cl». 

(in) nzmmm 

•JKX. ^fm^i>^<0^&BBXib^2^M^K. 

[0 1 3 4) tt*5. B6tt82^I^S©=|-7*tJ'--'<£ 

PCM7^?^i-^ 1 a%^t»M«*«:*jW47 -y 
- F^y d'WfI©±(*4^1'7'o 07 

tt*nss^SK « 5 is»s©** wtt«ua* ^ d » 

J»H"C*9. 7^aySWtcj:4fllfiS%H7 (a)K. . 
30 fr^i'*i#KJ:5M^i'? (b)(C^^^-T. * 
fc. H8BSA«»SS©««S©*#flW:»ia*w-r^ 
a,j;0t*D. 77d^S#lcj;5fltfiS*08 (a) 

T. Jgtc. BSKfct^ 05CC7irr!fU*i6Jf5?§©:? 

jrkoi»tb. m-ozmzm^xtmwmwtemt 

[ 0 l 3 5 ] ±2©^ I mWBBfcfc^Tt*. *7"1f- 
;S5 bF*3©#«^S**-riS*ntS!«r*»K 1/stL 

-^tcs*tis*si»s©Aft«ibt:. ^i^sffl^ss 

©^ i5^^ < i fc-£**3E±SidS©«aSK:«fc9« 
[0136] fe*s. !6K5it/0 7 »tftBii. 
d'»Hi^<ISI-'C**). »2*ll»«©*^1f— 

u-cfe^cawaitfttm** i ^5Sff^i-©t7if-^'5 

bi±<ISlt$-Ci!5'5>©-C l «T©WWC»v 
■C©flW»0*f¥©*B»!b. *©«!©»Wtt*«-r 
50 2>. 



(11) 

19 

[0137] m2mmi&<D*7 j ?->« l cmimft 

811. ±«©J:$«:*35£»a324StiTi,»sa*. 

(a) Kiivr*5K**tciMMMIBl 1 £=>>-f>-7 
1 Zt-r>cMffil 3Rt>'l 4(tJ; , ?1f$Ji£3*i*. - 

©70* 7«107 (b) Kfl*Tt>©ift*. *^ 

-c. *<7©t§£<D£itiw»K (z) {rtxxmn<om 

XttK (s) (f-fS?****©*^) B. 
[0138] x< 
[*4 3] K (z) =T/ (1 -Kpxz- 1 ) 
K (s) = 1/ (l+Tl(XttT2) Xs) 

[0139] 

[»4 4l 2-'=exp(-TXs) 
(,rt>&„ 

[0140] ffl 2HS0&«©iP< '<ft© 2 

rtawr*. 

[0 14l]-Mic. mQ^t^'ittv -F><v * 
■y - # - t"?: * - 7* i 7 a - XttJ&fc 3 1 * ii 

* 7tf- ^rt ©a^sjc^si^satffli >z t . 

^^I^«:*5i^-c^i^^^M©ffl^SKffl^e»n 

[ o 1 4 2 ] c ct?. s»^w^s©a»st ur 

138 (a) KwTJ:3K**SttMWHBl 5i3>f : > 
•tfl 6£ftttl 7Kj:*>flUS*ft4. -77. **©$# 
m*?*** ASWie J: •) filfiKf &ii£©7a 7*811 
«E8 (b) tcwTt>©ifti. **©JJ5£© 
iStW&K' (z) ( 7* P XttK' 

(s) 9 ». 

[0 14 3] 

[»45] K" (z) =T/ ( 1 -z- 1 ) 
K* (s) = 1/ (Tl(X«T2) x s) 
t^S^©* 5 ^^.^*!^). 

[0144] -u> ^mwM^us'M^ 
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[o 1 4 e i ffi*. ^mmms&vmntzt. -as 

(CjEra&ffiES h *>» < ft i> t l> 9 M«&#* 

9. ii«j(pffifttt**^<b-r*w*»'3-c*<. *»©» 

H * -* X*- #lW»*©t>©#*©1MiB4» it 

[0147] cwrasi^isijs-rsfcj&cc, 7 * 

•^-^*^>£l/^(c^yif-^'*^©tlIE4h^n^ 

<=>n&. i^tfr*^. ? 

r. c©^e-j-SBWH*S<c«?*-*-*«:». 

©iSf P«r iSW S c t WjiSJE i S ©"C * * • 
[0 1 4 83 K±IW!bfcJ:9K:, £2 
■y-/<©ttflF«c«tntf. » 1 ^If-''* 5 b 

«e*fflL>-s©t?. 3E£«#ffl©8t$MS*ffli'**»£K 

a - frtv d>«»ai©asaStt«Mlc|fiJ±3ti- 
(iv) g3HtBgS 

our. H9ASH1 l^ffl^fJftB^f 5. 
[0149] i^L/fc^ l RVmzmkBiBicte^x: 

(Digital Signal Processor) ?:fflU"C* 
7tf-/<£ or ©JCll^tf *>ti 5 . 
[0 150]Jtf.»3 g|lt^S8tC«4 1»>7 v 

^gp©«fiX(co^r. ii9?rffluri^-r^„ 

[0 1 5 1 ] «t*». H9BW3*iBB««:«*t»J»7 

[ 0 1 5 2 ] 0 9 tCTjVTcfc ^ K, ®3*JEWJ^©tStRff 
^g(cfcWSf7i'7 v7 , *iji5pgpPC' «. ±I2»1 

40 xa»2jttt»»otr» ^7 7 ^iM»»PC«:4»wi7 

*-*7sl7-^tBS2. M#§I3. S«fl%£e4R 
IfYv-i -imh 8 (C»P A r , A / D&ftS 2 0 i . SUfO 
^IS£Ur©DSP2 1 <h, RAM22£, ROM23 
£. D/A^feS§2 4 4. (C <fc ») 3 *rt (,>•*>. 

[0 1 5 3] C©<b*. DSP2 lrtlCti. &tlfflm«s 
2 1 aSom}tS*IS4UT©*^1f-^'2 1 b*ii; 

a*ffl«HMl«2 laSO'*7lf-^2 

1 b«> ROM2 3rtMi*3Snr^2)|l]ffl7-0^7A 
icS-^^r D S P 2 I *J»fW 4 C t tcj: 9 ^ttD S P 

so 2 i©mfig<tor^s*iSfc©-cs>s. C©it> S 
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tk*7+?-'i2 1 b %.ammm%2 1 aft**&£b 

[0154] *£, flfitt^lftWr 

[01551 jtef . ts *7 f rf IB. IS 1 X»*2 * 

7 4*2 UK Kijlt 41WRIB»BBK:» LT* K - *B ft 
*©SSW6«c2l-5l»"C*IUl®#Sppft4fiEL/ 

ottftu (s) (etas**. 

[0 156KXCC. 7*-Wi7-*BHS2B. &HJ 
S »r ^ * - * -X i v -ft ^ S feft 

u j»83©-j*©w?-Kai#Ts. 

[0157] Cftift'fr C"C, B«ft»£*4tt'. £12 
[ 0 1 5 8 ] *l/C. «MLe3 «. Btlffiffi^S ref© 

) ftir-rfliiWt^SerftftBSU. A/D 

[0159] CfUC<fc 0 . A/D3QIMB2 0 ». ffi!M<I 
# S erft 7 7 P JW*> 6 r 4 J/ jr jl/ft^Kaft b . ^ 

S ediffWaa-r » * S> *>MtW 

«Pffl««KqKffi^T-4. ) ft4«L,-CDSP2 1 ^IB2> 

rs. c©i*. s«A/D*»s2 0©saft«scr 



10 



30 



[0 167] 
[$4 6] 



0©g8UBKKad (diqit/m) 
[0 160] DSP2 Hi, f^yjuMtttW 

1f-/t2 1 b©fwy**tt&llifl«cj:*). F5-f7|5| 
S&8 £SE8bTr £/£fo©&ff{I-^ S ^MOTD/A^ 
ftS2 4^H0jT*. C©<tS, MSRDSP2 1B:. R 
OM2 3l*3«:-y«>«tt3*iTl»SW»^oy9AftOA 

(,»-CJblBfl[«ffl«a2 1 aRV*^-'<2 1 b&l/C* 

U (s) =AXwaV (s'+2XkXwaXs+wa l ) 

[0 168]%(C. 7f^»i-*l a©y-f»Q»ft- 

^ 3 i-? l a©2#MfcftK2<tl/-t^§g7 7? L * 

1 a©{£5iB8lfeft^-f 5>*/WRKSEtt-r*t. 
[0 169] 
[»4 7] 

Un (z) = Kg/ ( 1 + Kix z + K2X z"' ) 
[0170] MflPSytt. A/Dg 
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f-Z\A. ^A(8^SraiL"C-l6WtCRAM2 2«:tt 

[0161] cn«:j;<3. D/AS»a24B. IMHI 

* P *»flW S auft£l£ U"C F 7 -/ ^@SS 8 KHttT 
S. C©i$. a»D/A«JW2 4©«WMC Cf& 

P 9 9«atC*tt* D/AS»»2 4 ©SftiftftKda 
(Volt/diqit) 

[0162J*L/C. F9-f'<0IS8tt. WEflWC* 
£7 7 P #mtm^ S auftii*IT 6 <b Wc*©«E*K 
ttlfrJ-««»tfft«Tail«M!*S1 (SEtbSifci ) ft 
4fi*U 7*?»*~2 1 atCffi^L-CCnftiEMJl/'C 
ttUH^^ft^lbStf*. 

[ 0 1 6 3 ] 5«C. J:»L*:**«:*** K *7 » ? 
HSffPC ROT 1 a ftSMWaHRtCfc 

9««»qitC»&7 4 - Kv?9 f»CCOl>T. HI 0 

[0 164] fcfc. HI 1 btCfcWS 

HS«^aft^7P-^+-^^*'5-Si 1 Hi* 

7 7YWiff PC SO'7 7 9* a x - * 1 a ft£tt M»3fc 
4 - K^'f t>mW<0±ft%™?7v '> 
**t. HI lK4Hf»-C, 15ICijitSliia» 
»©7 *- ^M1»*«:J3t****l»»*iB-© 
WWSJfttc-3t»rtt. l3]-©1f^ftffl^Ttfflg|5©^B 

[o 1 6 5 ] jtr. jh3»s6»j»«c*jc»-cw. mwm 

U (s) »7*5-»x-* 1 at*SOT. *lJfflJ»y tt 

[0166]^-. * i Rumzmmm^m^tmmc 
gfrr??*.*.-* i a ©etw»ft2*a*i*«cifi« 
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+ -*^i9-«iUS2«:*jWSi5-(8^ttHi!BKt 
L,r©fiM^Hl!SgftKe<!:0. H*C. A/DS3W2 
OKteW-SStftSSKftKad (diqit/Volt) if €><!:> 
[0171) 

[»4 8 ] ref-yXKe=er 
KadXer=ediq 

[0 17 2] *^1f-^2 1 bWHIfiRRC^lWlFtC 
ol>tl 1 0S.DS1 lftfflir»"CUiW*S. 
[0 17 3] 1 btCte^TB. 5tT. 
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{fcfllWBMedifli-' tl>7>\>* A 5 >7mf©itfL^i&eh 
i££J!H>r. WT©J: 5 CtigWf6 (^f'^'Sl) 
[0174] 

[fk4 9 ] buf=edig+ehl 
h = k5dxbuf 

[0 1 7 5 ] C©££. ^^EfihrtK:. ±$&tm& 
^SLdisa#^£*TCl>£t:££frS. 
[0176] ±ia»H33n/cJgit>7"Jl-^ A S > 

ifomjEA hi. v* Mtmmm&ediqi 

^Wb&ftSud£|?liJU t J*fMi#Su£bTD/A 
gfc3§24^m;WS <*f-»7S2). 
[0 177] 

[ft 5 0 ] ud=ediqXC ( z) + h 
CCt« C (z ) \tmm^SZ 1 aVB.&M&Vh 
<3« ^SC (z) (D&WmibXte. w*«. 

[0 178] 

[ft 5 1 ] C (z) =Kp+Ki/ (1 -z-) +Kdx 
(1 -z") 

«-C**K KdttUHMItNbD. rxz-'jtwSh* 
?Stg«— 5>^iM©m£flX?rrS§i# (-r 

ab%. exp(-sxT) ( ; ntvyy'vyifmm 
££tc.&g£&Sig®) 

[ 0 1 7 9 ] * l/C. *tftCC. Xfy 7'S 1 

JHtHWffiud£ «rfflO»T. JJW" >7Jl/* -f 5 > ^©* 7 
If - / <rtSH©±Se«S^£»*SR» 0. t *i £ ehl£ b T 

fTT-S (^f- y 7'S 3) . 
[0 180] 

[$5 2] ehl= [ { (udxk4d -bufxkld) XT/ 
(1 -Kpixz- 1 ) } -bufxk2d] xk3dxT/ 
( 1 -Kp2X z" 1 ) 

ccr. kid. k2d. k4dKtfk3dttSBlXtt»2 
HKlJKSlKfcWS^kl. k2. k4&tfk3£**? i -f 

K da ( Volt/digit) b?2>l. 
[0181] 

[ft53] kld=w rV (AXwa'xKeXKad) 
k2d = 2 xk r xw r/ (AXwa'xKeXKad) 
k5d = 1 / (XdrXKdaX AXwa'xKeXKad) 
kid =KdaXKdr 
k3d = AXwa' xKexKad 



4#BB 2000-235403 
24 

MtCKp:i&tfKp2U>F3fe£?S#©fc#©fia£*g 
5ET£G?ift ( 0 <Kpl, Kp2< 1 ) -chh. 
[0182] C©fttt. ±12 ^ -f ^Wb&ftSucf&D 
/ASQftS 2 4 icd; 0 7^" a ^bbT 7* a ^gfeft^ 
Sau*4J3EU CtlKJ;*) F5 4^K8*liSbVC± 
S2iHWi*tSi4£fi&U 7 l.afcHWjU 

[0 18 3]CCf. ±12X7- *7 - S 1 ibT. 
7'rt/ jr 5 > ^©ffliEfih *— r > # -V 5 > ^ © 

[0184] iEtttt*lHSl©fc«>fctt. **«^-tJ->7'Jl/ 
* 4 5 > ^©ttSS^ft^^-CJI-9-> 7> jr A 5 > ^© 

tnit>t:» % ti * at? * o . ±ia ^r-^'si ©fwisr » 

*&j£ftT**©rffiIEfih©i?gCtttffl(,>SC £#"C 
5 > #©1*<i^ft©ftffl £ l/T fflc>ri, > S©T* s. 

[0185] ftsmi*. > 7* >; > a - 

K^-i a ^Mffl*©^-Jl<»*£ifc«tr+»(C||WtlW 
-It > 7'^ ^ A 5 > ^©Jlti BIQB£ ttft 6 * l» C £ * 

[0186] tt48. ±»l/fc»3Wl!»»K:*l.>rtt. 

. ±«e@«fiS r e f iri-ui/m^ri i/TEPttrr aflusee 

&A/D^}Hb /dg^f 1 ' a i> Z M&t LTJilT© J: ^ tC 
[0187] 

[ft5 4] yxKe=er 
ref-KadXer=ediq 

tic. 13lkS3»StCfl>TB, D/A^feS 
2 4 K «t 9 !»f¥ if^ S u5r Ti~& S autClEft 

T5l«)i!<;?:mUfc^. CtxWKc. PWM (Pulse Wid 
' th Modulation) @»««:J:»)ftf¥m#Su*»6r^o 
40 yafpg-^SauiilSf 4J:9K«fiS , r4C£<>-C* 

[0 1 8 8 ] MtC ±8©S3Hit^®c*$l>rtt. f 
•v i7 7 7 7" 1 ft©»«I U>XK»tS 7 * 

moms immui? z c £ -cw<}E£ a a c £ as ^ * 
[oi89] Htcssfc. (a*ffli«s*±SB» i ^ifem^ 
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[0 190] 

3W3«:«j:*i«. x*©^. -*©aau*»fflw«>ft 

ft^fc. z^©«JMtt©3*t>£tri$tt#8a«:.fc9£ 

[0191] ffi.t, «»ft*««w**a»**« 
if - ^tnaisi i > t l* twEE u oo±e u www 

[0192] tmm 2 KE*)l©IMBW: J:h«. sS*JR 1 20 

u-c 7 < - hv< » ^^©attttttfcwcAis* * 
[0193] n^si3KiBtta>i&««:j:ntf. i 

fgrt SP* -f ^©^^S^tfiS y X2?#£&1" 3C 
CCtJU-C 4> . <fc «J iEtffi K^a* ft ST 5 C i #T' * i> . 
[0194] 8B*3«4lcSElE©*W«:j:ntt. 1 

5 > ytefcl'T r ^ y SuHbS *ifcttff*i . JJHf> 7' 

7';u W s > y©$f Sl£it/i1" i©"C , J; •) JEtttcM-a 
[0195] 5 CCfHJKCfclBCCfchtf. »*W 1 4 

1*--sKWffll*®©5^i>&< tfcl^f tl*»-^"C*4© 
•C. »Hfi-3*aft«ia6-C <t ») £5fitc^Sl*MI£ 

•watt? +>y-9--#moxii7*-*xi>--# 

WUBKCteft h 7 •* - K * y HffimZ'fi 9 C £ 
[0196] »JfcJI6«ClBtH©»!BK:<fc4'i{<. -#© 
Jf v — ^^RO^© 5 !*^ < £ fc£&iW*t&K 

c»rz^©3I©**Stri#tt^SS:«:J:*)S*3n*« ! 
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*©ttJlifcrt«*? s ^*fflc»Tfl-Si*ifi£?5©'C. 
-#wiiWfffirt«:n*ttfli»s©«-sutt£ra*^tf»* 
«:. -wmuftomz ^tstmism&t <t o ss$ 
n 5 flgB* -f fciefflr sn-s- « tk L/ riEBi.§.-7 sate 

[0197] ffi,t, HJ^j:;»sS©ttSLSJ^S«:J:9 
[0198] »*3S7«:ffitt©»?8K:«thtf. ii^6 

[Hli©ffl*tt8K8] 

[0 1 ] *«w©j8ai*«iW"r*ia < i > -c*o . 

(a ) tJ/U^^SOIW^JRRCfli^^MW***© 
>o «»-J«*»»tt***Ht?*»). (b)«^ne,©(4 
ffl - JBffl»«tt«r*-r H t? * i . 
[02] #£91©flSQI*W9if*IH (II) -C*0. 
( a ) ttW»*f«R£/* ^if-z^CrtW^f^SftKii 
i O /cii&©ftSI> ^> «HW ^'©^ ©W» - W 
jgi$f#t§£^-rilt-£> 0 . ( b ) B*©t4ffl - ®$LW& 

[H3] *#6iJI3©JRJI«:«Wr*ia (III) r**>. 
(a) Bl«P«»t'<*-?^«t U*^f w«0iWE 
r^SlRtt*©^*^^ i ^cti#©?fSL^e>*llfPffl 

30 s*-c©Ba©*'J»-Hifia» j m±*'s-rH-c* , 3. <b) 

CB4) fVl Hfeg»©1«*W4*iB©«S«fiES:^-r 

la 5 ] » 1 ms^sgotina*©^*^"?- xo » *u 
me ] m2^M^©*w*©^ ; &^t-7'D 

[07] I2Ii»i^©H^^tit$)0 . 
(a) |J7to?mK«t4M^t7D ?*H-Cifc 
40 <>). (b) teT<is2M%mt£Z>i%f&*^~?7'nv>? 

[08] ^^ffl«-S©ffl»S©«liS«:*-rH"C* <0 . 
(a) B7^P* r «WKJ:*«l»*m'r^0 9d'H"C* 
(b> tefiist'MfinicZZW&ZTK'ffUvZ 

[09)^3 mmm.mnn^s.onmm^ynt 

[010] » 3 *«»«©* ^-'<©«91**r7 P 
50 [011)^3 JBS^SBroWffli*©*!!^*^ v f 
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